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Die folgenden Angaben sind den vom Anmelder eingereichten Unterlagen entnommen 

Prufungsantrag gem. § 44 PatG ist gestellt 

(3) Verfahren und Vorrichtung zur Unterstutzung des Einparkens eines Kraftfahrzeugs 

(57) Die Erfindung befasst sich mit einem Verfahren und ei- 
ner Vorrichtung zur Unterstutzung des Einparkens eines 
Kraftfahrzeugs, d. h. mit einem Einparkassistenten. Aus 
von Sensoren (2) gelieferten Fahrzustandssignalen wird 
in einem Funktionsblock (3) eine Soll-Trajektorie berech- 
net. Diese besteht aus Klothoidbogen und/oder Kreisbo- 
gen. Ferner wird auf der Basis der von den Sensoren (2) 
gelieferten Signale, insbesondere eines Gierwinkelsi- 
gnalsund eines Wegesignals, eine Ist-Trajektorie in einem 
Funktionsblock (4) berechnet. Dann werden Soil- und Ist- 
Trajektorien verglichen, und das Vergleichsergebnis er- 
moglicht eine mit den Phasen des Einparkvorgangs 
schritthaltende Berechnung des Lenkwinkels, fur den in 
einem Funktionsblock (5) eine StellgroBe ermittelt wird. 
Von den Sensoren (2) gelieferte Feed-back-Signale er- 
moglichen eine genaue Regelung der wahrend des Ein- 
parkvorgangs eingeschlagenen Lenkwinkel. Lenkradein- 
griffe des Fahrers werden toleriert, haben aber keine Aus- 
wirkung auf den Lenkwinkel. Der Fahrer muss lediglich 
Gas- und Bremspedal betatigen, um die Fahrgeschwin- 
digkeit des Fahrzeugs zu beeinflussen. 
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Beschreibung 
Stand der Technik 

5 Die Erfindung hetrifft ein Verfahren zur Unterstiilzung des Einparkens eines Kraft fahrzeugs, das mil einem Lenksiell- 
motor und Sensoren zum Erfassen der Fahrzeugposition, des Fahrzustands und veranderlicher Uingebungsbedingungen 
ausgerustel ist, wobei auf den Befehl eines Fahrers hin cine geregelte Unterstiilzung des Einparkvorgangs mitlcls des 
Lenkstellers und gestutzt auf vorbestimmte Fahrzeugdaten und auf Signale der Sensoren ausgcfuhrl wird, sowie ein zur 
Durchfuhrung des Veriahrens eingerichtete Vorrichtung. 

10 Bei einem zur Zeit bei der Robert Bosch GmbH in der Eniwicklung befindlichen elektronischen Lenksyslem wird 
durch einen am Lenkgelricbc der Vorderrader angebrachten elektronisch geregelten Lenksteller, ausgehend von einem 
von einem Lenkradsensor erfassten Fahrerlenkwunsch unter Berucksichtigung von fahrdynamischen GroBen die Quer- 
dynamik durch eine Modi fi kali on des dem Fahrerlenkwunsch entsprechenden Txnkwinkels verbessert, d. h., dass das 
Fahrzeug in fahrdynamischen Situationen stabilisiert wird. Das System weist einen Lenkstellmotor auf, der dem vom 

15 Fahrer gestellten Lenkwinkel einen Korrekturwinkel hinzuaddiert. 

Die DE 29 01 504 beschreibt ein Verfahren und eine Vorrichlung zum Einparken von Kraftfahrzeugen, welche mit ei- 
ner reinen Steuerung des Einparkvorgangs arbeitet. Dabei werden keine den Veriauf der Einpark-Trajektorie verandernde 
Feed-Back-Signale berucksichtigt, sondern siatt dessen feste Trajektorien vorgegeben. 

Aus dem Patent FR 2 728 859 ist ein Verfahren und eine Vorrichtung zur Regelung des Einparkvorgangs bekannt. Da- 

20 bei ist aber der Fahrer noch zustandig, um Lenkeingriffe durchzufuhren. Dazu werden Sensoren verwendet, die den Gier- 
winkel und den Lenkwinkel erfassen. Unbefriedigend ist dabei, dass die Leistung des damit realisierten Systems durch 
die relativ groBe Totzeit des Fahrers bei den Lenkeingriffen beeintrachtigt ist. 

Aufgabe und Vorteile der Erfindung 

25 

Es ist Aufgabe der Erfindung, ein Verfahren und eine Vorrichlung zur Unterslulzung des Einparkens eines Kraftfahr- 
zcugs so zu crrnoglichcn, dass das Fahrzeug automatisch in die Parkluckc lenkt, der Fahrer aber sclbst durch Gaspcdal- 
und BremspedaleingrifTe die Geschwindigkeit regelt. 

Die obige Aufgabe wird anspruchsgemaB gelost. 
30 GemaB einem wesentlichen Aspekt ist das die obige Aufgabe losende Verfahren gekennzeichnet durch folgende 
Schritte: 

A Erfassung einer das unterstutzte Einparken initiierenden Befehlseingabe des Fahrers und Erzeugung eines Initia- 
lisierungssignals; 

35 B Erfassung der momentanen Fahrzeugposition und des Fahrzustands aus den Fahrzeugdaten und wenigstens aus 

einem Gierwinkelsignal und aus einem Wegesignal; 

C Erfassung der Umgebungsbedingungen aus von an dem Fahrzeug angebrachten Sensoren erzeugten Signalen; 
D Vorgabe einer oder mehrerer Soil-Taj ektorien, die eine von der Fahrzeugposition, dem Fahrzustand, den Umge- 
bungsbedingungen und den Fahrzeugdaten abhangige Soll-Bahnkurve des einzuparkenden Fahrzeugs angeben; 
40 E Erfassung einer jeweiligen Ist-Trajektorie, abhangig von den jeweiligen in den Schritten B und C erfassten Si- 

gnalen; 

F Vergleich der in Schritt D vorgegebenen Soll-Trajektorie und der in Schritt E erfassten Ist-Trajektorie; und 

G Berechnung der jeweiligen StellgroBe fur den Lenkstellmotor aus dem in Schritt F erhaltenen Vergleichsergeb- 

nis. 

45 

Dabei wird das in Schritt B erfasste Wegesignal vorteilhafterweise von einem Weggeber, vorzugsweise von je einem 
an jedem Fahrzeugrad befindlichen Radgeschwindigkeitssensor, erfasst. Das ebenfalls in Schritt erfasste Gierwinkelsi- 
gnal kann ent weder durch einen geeigneten Sensor gemessen werden oder aber aus geeigneten Signalen, bspw. aus der 
Drehrate eines Drehratensensors und/oder aus den Radgeschwindigkciten, rekonsu-uiert werden. 
50 Die Umgebungsbedingungen werden in Schritt C vorzugsweise mittels eines Ultraschall sensors erfaBt. Es ist jedoch 
auch denkbar Radarsensoren oder optische Sensoren, z. B. Kameras, einzusetzen. Die in Schritt C erfassten Umgebungs- 
bedingungen konnen die Form oder AusmaBe einer Parklucke angeben. 

Die oder jede in Schritt D vorgegebene Soll-Trajektorie wird bevorzugt aus einem oder mehreren Klothoidbogen und/ 
oder aus einem oder mehreren Kreisbogen zusammengesetzt. Ein Klothoid ist eine ebene Kurve, deren Kriimmungsra- 
55 dius gemaB der Beziehung R = a • a/s (R: Krummungsradius; s: Bogenlange; a: Parameter) stetig kleiner wird. 

Um zu vermeiden, dass die Lenkbeschleunigung und der Lenkruck zu hoch werden, wird die im Schritt E berechnete 
StellgroBe einer Filterung unterworfen, die abrupte Ubergange an den Flanken der StellgroBe glattet. 

Eine zur Durchfiihrung des Verfahrens eingerichtete Vorrichtung weist erfindungsgemaB eine Regel-/ Steuereinheit, 
die von den Sensoren in Abhangigkeit von der Fahrzeugposition, dem Fahrzustand und den veranderlichen Umgebungs- 
60 bedingungen erzeugten Signale sowie die Fahrzeugdaten empfangt, Mittel zur Berechnung einer Tst-Trajektorie aus den 
Sensorsignalen und den Fahrzeugdaten, Mittel zum Vergleich der jeweils berechneten Ist-Trajektorie mit einer vorbe- 
stimmten Soll-Trajektorie und Mittel zur Berechnung einer StellgroBe fur einen Lenkstellmotor aus dem Vergleichser- 
gebnis auf. 

Die das Verfahren durchfuhrende Regel-/Steuereinheit kann uber Filtemiittel verfugen oder uber Filtermittel mil dem 
65 Lenkstellmotor verbunden sein, so dass die berechnete StellgroBe in der oben beschriebenen Weise gefiltert werden 
kann. 

Das oben spezifizierte Verfahren und die Vorrichtung bieten gegenuber dem Stand der Technik mehrere Vorteile: 
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- Ms wird kcine echle clcktronischc Steer-by-Wire-Lcnkung benotigt. Der bei dcm in dcr Entwicklung bcftndlichcn 
fahrdynamischcn Lenksystem eingcsctzte Lenkstclliiioior isl ausrcichend, da er automatische. genauc und schr 
fcine Lcnkcingriffe ermoglicht. 

- Die verwcndelen Sensoren ermoglichen eine genauc Bcrechnung der gefahrenen Bahnkurve und daiuil eine ge- 
nauc Rcgelung des Einparkvorgangs mil standigen Korrekturen und Anpassungcn. > 

- Die Auswahl der jeweiligen Soll-Trajeklorie und ihre Kombination aus Klothoidbogen und Kreisbogen ermog- 
lichl eine cinfachc Beschreibung der Trajektorie und cine schnellc Bcrechnung des Vergleichsergebnisscs zwischen 
Ist- und Soll-Trajekiorie wahrend des Einparkvorgangs. 

Die durch die RegeWSleuereinhcit ausgeiiihrte Regelung ermoglichl ein prazises Manover und lemporare Ab- 
weichungen von der Soll-Trajeklorie, um den Fahrkonifort zu erhohen. io 

- Die Filterung erhohl den Fahrkonifort, da sic ruckhaftc Bcwcgungcn des I^enkrads giallen kann. 

Die nachstehendc Beschreibung beschreibl ein hevorzugles Ausfuhrungsbeispiel des erfindungsgemaBen Verfahrens 
und erlautert gleichzeitig die Durchfuhrung durch die erfindungsgemaBe \forrichlung unter Bezug auf die bciliegende 
Zeichnung. 15 

Zeichnung 

Fig. 1 zeigt schematisch Funktionsblocke der erfindungsgemaBen Vorrichlung; 

Fig. 2 zeigt graphisch die gcomelrische Grundlage zur Ermittlung einer Bahnkurve uber den Zusainmenhang zwi- 20 
schen deni Krummungsradius R. dem Winkel 6 und dem Weg s: 

Fig. 3 zeigt graphisch ein Klothoid als ein Kurve, deren Krummung c(s) sich linear mil dem Weg s vcrandert; 

Fig. 4 veranschaulichl in einer ebenen Darstcllung eines Kraft fahrzeugs GroBen, die zur Bestimmung der Klolhoidbo- 
gen dienen; 

Fig. 5 erlautert graphisch eine Trajektorie und einen Lenkwinkel fiir einen Fall, wo eine Fahrl am Lenkeinschlag not- 25 
wendig isl; 

Fig. 6 zeigt graphisch cine Trajektorie und einen Lenkwinkel fur einen Fall, wo kcinc Fahrt am Lenkeinschlag not- 
wendig ist; 

Fig. 7 zeigt eine mil dem dargeslellten Algorithmus erzielte Einpark-Trajektorie. 

Ausfuhrungsbeispiel 

Das im nachfolgenden Text dargestellte Ausfuhrungsbeispiel eines erfindungsgemaBen Verfahrens zur Unterstutzung 
des Einparkens eines Kraftfahrzeugs und einer zur Durchfuhrung des Verfahrens eingerichteten Vorrichlung (kurz: Ein- 
parkassistent) verwendet insbesondere folgende Sensoren: 35 

- UlLragschallsensoren zur Erfassung der Umgebungsbedingungen: 

- aktive Radgeschwindigkeitssensoren, die Radgeschwindigkeiissignale bis zum Stillstand des Fahrzeugs liefern; 

- einen Lenkwinkel sensor; 

- einen Drehraten sensor, mil dem Sign ale uber die Giergeschwindigkeit crfassbar sind; und 40 

- (optioneil) einen Querbeschleunigungssenson 

Es ist denkbar, in einem anderen Ausfuhrungsbeispiel der vorliegenden Erfindung einen oder mehrere der beispielhafl 
angefiihrten Sensoren wegzulassen, entweder weil das erfindungsgemaBe Verfahren auch ohne das von dem entsprechen- 
den Sensor gelieferte Sensorsignal voll funktionsfahig isU oder weil das Sensorsignal aus anderen Sensorsignalen rekon- 45 
struiert werden kann. Welche Sensoren zur Durchfuhrung des erfindungsgemaBen Verfahrens tatsachlich eingesetzl wer- 
den kann von einem Fachmann anhand seines Fachwissens im Einzelfall entschieden werden. Es ware es bspw. denkbar, 
auf einen Drehraten sensor zu verzichten und das Drehratensignal aus anderen Sensorsignalen zu rekonstruieren. 

Fig. 1 zeigt Funktionsblocke des Einparkassistenten. Aus dem Block 1 stehen Fahrzeugdaten zur Verfugung. Bei- 
spielswcise ist der Block 1 ein Speichcr, in dem die Fahrzeugdaten abgespeichert sind. Eine alternative Moglichkeil isl 50 
ein Rege!-/Steuerwerk, das die Fahrzeugdaten en thai I . Der Block 2 ist der Sensorblock, der die oben erwahnten Sensoren 
umfasst. Der Funktionsblock 3 berechnet die Soll-Trajektorie in der weiter unten beschriebenen Weise und erhalt dazu 
die Fahrzeugdaten aus dem Block 1 und die Sensorsignale aus dem Block 2. 

Ein zur Ermittlung der 1st -Trajektorie vorgesehener Funktionsblock 4 erhalt ebenfalls die Fahrzeugdaten aus dem 
Block 1 und die Sensorsignale aus dem Block 2 als Eingangssignale. Insbesondere ist der Drehraten sensor zur Rekon- 55 
struktion des Gierwinkels wichtig. Alternativ kann der Gierwinkel auch durch einen entsprechenden Gicrwinkelsensor 
geinessen werden. 

Die im Block 3 vorgegebenc Soll-Trajektorie und die im Block 4 ermit telle 1st -Trajektorie werden in einem Vcrglei- 
cher 8 vcrg lichen. Aus dem Vergleichsergebnis und aus Signalen der Blocke 1 und 2 berechnet der Funktionsblock 5 die 
StellgroRe. Der Vergleich zwischen den Soil- und Tsl-Trajektorien ennoglichl eine genaue Regelung des Lenkwinkels r>0 
mittels der im Block 5 berechneten StellgroBe. Diese Regelung ist moglich, da die Lenkeingriffe von einer Regel-/Stcu- 
ereinheit ausgefuhrt werden. Die itn Funktionsblock 5 berechnete StellgroBe wird im Funktionsblock 6 gefiltert. Diese 
Filterung bewirkt eine Glaltung der Flanke der StellgroBe und erreicht damit, dass die Lenkbeschleunigung und der Ruck 
am Lenkrad nicht zu hoch werden. AuBerdem werden dem Funktionsblock 6 auch Fahrzeugdaten aus dcm Block 1 zu- 
gefuhrt und dort gefiltert oder in die Filterung der StellgroBe mil einbezogen. 65 

In dem Verglcicher 8 konnen neben dcr Ist- und der Soll-Trajektorie auch Fahrzustandssignale, bspw. die Oricntierung 
des Kraftfahrzeugs, mileinander oder mil den Fahrzeugdaten vcrg lichen werden. Der Funktionsblock 7 reprasenliert ein 
Stellglied, das als ein Lcnkstellmotor ausgebildet ist. Die Sensoren und der Lenkstellmotor konnen Teil eines fahrdyna- 
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mischen Lenksyslems des Kraftfahrzeugs sein. Die zusatzlichcn Kostcn fur cine crfindungsgemaBe Vorrichtung in eineni 
Kraft fahrzeug konnen so auf ein Minimum redzuiert werden. 

Die oben bezogen auf Fig. 1 beschriebenen Funktionen des Einparkassistenten konnen von einer RcgelVSteuereinheit, 
z. B. eineni ohnehin im Fahrzeug vorhandenen Fahrzeugrechner ausgefuhrt werden. 

Nachstehend werden unler Bezug auf die Fig. 2 und 3 die geometrischen Gmndlagcn zur Ennitllung einer Trajcklorie 
auf der Basis eines Klothoidbogens beschrieben. 

In Fig. 2 ist graphisch der Zusammenhang zwischen dem Kriimmungsradius R, dem Winkel 9 und deni Weg s einer 
beliebigen Bahnkurve veranschaulicht. Fig. 2 zeigt, wie der Winkel 6 sich mil der Anderung des Wegs s in Abhangigkcit 
vom Kxummungs radius R verhalt. Die Krummung c(s) ist mil Gleichung 1.1 gegeben: 



C(S) = 



de 
ds 



Gl. 1.1 



Der Winkel 0 berechnet sich aus dem Weg s anhand der folgenden Gleichung: 

Gl. 1.2 
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Diese Gleichung laBt sich mil Hilfe der Gleichung 1.1 wie folgl ausdriicken: 
$ 



e{s)=e 0 +]c{s)ds 



Gl. 1.3 



Aus dem Winkel 9(s) werden die kleinen Anderungen (dx, dy) der karlesischen Koordinaten (x, y) berechnet: 
cos (9) • ds] 

_sin(8) * dsj 

Die Koordinaten (x, y) werden aus der Gleichung 1 .4 abgeleilel: 



rdx(s>1 ("c 
[dy(s)J L 



;] 



Gl . 1.4 



' f I 



Gl. 1.5 



Die allgemeine Gleichung 1 .5 wird fur den speziellen Fall der Klolhoide vereinfacht. Die Klothoide isl einc Kurve. de- 
ren Kriimniung c(s) sich linear mit dem Weg s verandert. Diese Kurve wird auch als Cornu-Spirale (siehe Fig. 3) be- 
zeichnet. 

c(s) = k • s + Co Gl. 1.6 

Aus dem Einsalz. der Krummung (siehe Gl. 1.6) in die Formel 1.5 ergibl sich: 



[a- 



x 0 + Jcosj 6 0 + j (fc • w + c 0 )• dw \ dt 

\ > r i 

dt 



y Q + Jsin 6 6 + ](<c • w + c 0 )• dw 
\ • 

was sich unler den Bedingungen: 
e 0 = 0, x 0 =0c 0 = 0, y 0 = 0 Gl. 1.8 
65 wie folgl vereinfachen lasst: 



Gl. 1.7 



4 
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Mi*- 11 }* 



Gl. 1.9 



Die Integration der Funklionen sin(u 2 ) und cos(u 2 ) isi nicht trivial. Ual'ur wird die Reihenentwicklung der Irigonoiiie- 
trischen Funklionen angewandt. 



B!]= 



s 

\ 



dt 



2n+\ \ 



dt 



Gl. 1.10 



Unler besliiiuiilcn Bedingungen von Konvergenzen der Reihen (Gl 1.10) kann die Reihenfolge der Suiimie und der In- 
tegration invcrticrt werden. Dicsc Bedingungen sind in dem vorlicgcndcn Ausfuhrungsbcispicl (Gl. 1.10) crfullt. 



— dt 



Gl. 1.11 



Die Gleichung (1.11) lasst sich wie folgt transformieren: 

4lt*l 



ks' 



5 ( " l)r -2.(4n + l)(2H) 
s 



5^ "2-(4n + 3)-(2ii + U. 



Gl. 1.12 
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5" 

T 



10 + 120 ~9360 1 685440 

V s» ) 
^6894720 J 



* n 

• + 



42 1320 75600 



Gl. 1.13 
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65 



Die Gleichung 1.13 dientdazu, bedeutende Punkle der Trajektorie schnell zu berechnen. Im foigenden Abschnitt wird 
das Verfahren angewandt, um eine Einpark-Trajektorie zu berechnen. 

Weiterhin wird bczogen auf die Fig. 4 bis 7 die Einpark-Trajektorie mil Hilfeeines Algorithnius berechneU der auf der 
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vorangehcnd erlaulerlen Gleichung 1.13 beruht. 

Intuitiver Lenkvorgang 

Es sei angcnonmien, dass das zu parkende Fahr/eug parallel zu der Parkliicke sleht. Die Trajektoric in der Langsrich- 
tung wird passend zu der existicrenden Parkliicke vorausgesctzt. Inluitiv soil die Einpark-Trajektorie die folgenden Pha- 
sen beinhalten: 



to 



15 



1 . Geradeaus ruckwarts lahren, 

2. weiterfahren (eveniuell langsamer) und das Lenkrad nach rechts bis zu deni Lenkeinschlag drehen, 

3. weiter ruckwarts fahren, 

4. Lenkrad nach links bis zum Lenkeinschlag drehen, 

5. weiler ruckwarts fahren, 

6. Lenkrad wieder gerade stellen, und 

7. das Fahrzeug anhallen. 



Berechnung des Lenkwinkels 

Die oben beschriebenen inluitiven Phasen sollen fornialisiert werden. 

20 - Wegen der einfachen Handhabung von Klolhoiden wird angenommen, dass die Phasen 2, 4 und 7 Klothoid-Tra- 

jektorien sind. 

- Wegen der Symmeirie des Einparkvorgangs sind die Phasen 2 und 6, 3 und 5 symmet risen. 

Die Bestimmung der Phase 2 wird anhand der Fig. 4 hergeleitet. Die Klothoide sind durch einen Parameter k be- 
25 stimint, der auf der Begrenzung des Lenkwinkels und der Fahr- und Lenkgeschwindigkeiten beruht. 

Die Lange der Phase 3 ist so berechneL, dass das Fahrzeug lief genug in die Parkliicke fahrL. Der Einfluss dieser Lange 
auf die Trajektoric wird anhand der Fig. 6 und 7 dargcstcllt. Insbcsondcrc zcigt die Fig. 6 die Trajektoric des Fahrzcugs, 
wenn die Phase 4 nicht existiert. 

Die wichtigen Punkte fur die Berechnung der Trajektorie sind in den Fig. 5 und 6 mit den Buchstaben A, B, C. D, E. F, 
30 G, R gekennzeichnet. 

In Fig. 4 ist schematisch bei einem Fahrzeug mit eingeschlagenen Vorderradern der sich ergebende Radius R = l/c(s) 
und der Lenkwinkel 6(s) dargestellt. Die Klothoide ergibt sich zu 



35 



c(s) = k • s + c 0 Gl. 2.1 

Der Ackermannwinkel ist 
6(s) = arctanfL • c(s)] Gl. 2.2 



40 



c = tan 



Gl. 2.3 
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Daraus ergibt sich: 



k • s max s tan 



50 Dies ergibt 



s-"** = — . tan 
k 



Ft] 



Der Lenkwinkel ergibt sich zu: 

L-c L-k-v 



Gl. 2.4 



Gl. 2.5 



5 = 



1+ [L*c] 



1+ [L-c] 2 



Gl . 2 . 6 



Daraus erhalt man den fiir die Klothoide bestimmenden Parameter: 



k = 



z max 



Gl . 2.7 



L - v max 

Dabei findet eine Begrenzung der Lenkwinkelgeschwindigkcit 6 < & M max 9 des Lenkwinkels 8 < 8 v max und der Falir- 
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geschwindigkeit v < v" ,aA statl. Das Ergcbnis dcs Binparkvorgangs mit dem zuvor erlautcrten Algorithmus ist in Fig. 7 
dargesielh, welche in einem x-y-Koordinatensystem cine beispielhaftc Einpark-Frajektorie und den zugrundelicgcnden 
Soll-Lenkwinkel veranschaulicht. 

Um die Steuerung im Fahrzeug zu programmieren, wird der gefahrene Weg bendugt. Ini Fahrzeug wird dieser Weg 
mil aktiven Radgeschwindigkeitssensoren oder in vereinfachter Form mit Hilfe eines Weggebers gemessen. Die Radge- 5 
schwindigkeitssensoren konnen die Radgeschwindigkeit bis zur Geschwindigkeit Null prazise erfassen. 

Bei dcm oben beschriebenen System darf der Fahrer wahrend des Ein park vorgangs Lenkeingriffe durchfuhren. Diese 
Lenkeingriffe haben aber keinen EinfluB auf das Manover. Falls beini Einparken ein Hindcrnis im Wege stent, soli der 
Fahrer bremsen und den Einparkvorgang stoppen. Da der Lenkradwinkel mit dem zugrundeliegenden Lenksyslem sen- 
sorisch erfassi wird, werden die Fahrereingriffe am Lenkrad durch den Lenkstellmotor wahrend des Einparkens kompen- H) 
siert. Diese Vorgehensweise ermoglicht, dass der Fahrer trotzdem das Gefiihl hat, den Einparkvorgang sclbst zu steuern 
und sich deshalb wohl fuhlt. 

Aufgrund der voni Drehratensensor gclieferten Signale wird der Gierwinkel berechnet. Rei hochdynamischen Fahr- 
manovern kann diese Berechnung u. U. zeitlich problematisch sein. Beim Einparken treten dagegen in der Regel keine 
Schwierigkciten auf, da sich die Fahrgeschwindigkeit und die Dynamik des Fahrmanovers in Grenzen halt. 15 

Somil ermoglicht der Einparkassisleni liber die Berechnung des Gierwinkels eine echte Regelung des Lenkwinkels 
durchzufuhren, damit die Fahrzeugorientierung dem erwarteten Verhallen entspricht. Mit dieser Regelung konnen Feh- 
ler, die zu einer Abweichung zwischen den gefahrenen und der berechneten Trajektorie fiihren konnen, wie bspw. Fehler 
in der Lenkanlage oder unterschiedliche Reibungen, korrigiert werden. 

Da der Sprung des dem Lenkstellmotor als StellgroBe zugefuhrten Signals zwischen den Phasen, in denen der Lenk- 20 
winkel konstani ist (Phasen 1, 3 und 5) und den Phasen, in denen sich der Lenkwinkel verandert, zunachst abrupt isl, wird 
die StellgroBe in dem in Fig. 1 gezeigten Funktionsblock 6 gefiltert, indem die abrupten Spriinge der StellgroBe geglattet 
werden. Dabei kann die StellgroBe gefiltert werden, damit die Lenkbeschleunigung begrenzt ist. Da die Soli- Trajektorie 
unverandert bleibt, konnen Abweichungen von der Soll-Trajektorie auftreten. Es werden also temporare Abweichungen 
von der Soll-Trajektorie geduldet, urn ein gleichformiges Fahrmanover zu ermoglichen und urn dadurch den Fahrkom- 25 
fori zu erhohen. Die Abweichungen zwischen der Soll-Trajektorie und der Ist-TYajektorie werden im Laufe des Binpark- 
vorgangs durch die Rcgcl-/ Stcucrcinhcit mit Hilfe dcs crfindungsgcmaBcn Vcrfahrcns korrigiert. 



Patentanspruche 



30 



1. Verfahren zur Unterstiitzung des Einparkens eines Kraftfahrzeugs, das mit einem Lenkstellmotor und Sensoren 
zum Erfassen der Fahrzeugposition, des Fahrzustands und veranderlicher Umgebungsbedingungen ausgeriistet ist, 
wobei auf den Befehl eines Fahrers hin eine geregelte Unterstutzung des Einparkvorgangs mittels des Lenkstellers 
und gestutzt auf vorbestinuute Fahrzeugdaten und auf Signale der Sensoren ausgefuhrt wird, gekennzeichnet 
durch folgende Schritte: 35 

A Erfassung einer das unterstutzte Einparken initiierenden Befehlseingabe des Fahrers und Erzeugung eines 
Initialisierungssignals; 

B Erfassung der momentanen Fahrzeugposition und des Fahrzustands aus den Fahrzeugdaten und wenigstens 
aus einem Gierwinkelsignal und aus einem Wegesignal; 

C Erfassung der Umgebungsbedingungen aus von an dem Fahrzeug angebrachten Sensoren erzeugten Signa- 40 
len; 

D Vorgabe einer oder mehrerer Soll-Tajektorien, die eine von der Fahrzeugposition, dem Fahrzu stand, den 
Umgebungsbedingungen und den Fahrzeugdaten abhangige Soll-Bahnkurve des einzuparkenden Fahrzeugs 
angeben; 

E Erfassung einer jeweiligen Ist- Trajektorie, abhangig von den jeweiligen in den Schritten B und C erfassten 45 
Signalen; 

F Vergleich der in Schritt D vorgegebenen Soll-Trajektorie und der in Schritt E erfassten Ist-Trajektorie; und 
G Berechnung der jeweiligen StellgroBe fur den Lenkstellmotor aus dem in Schritt F erhaltenen Vergleichs- 
ergebnis. 

2. Verfahren nach Anspruch 1, dadurch gekennzeichnet, dass der Lenkstellmotor und zumindest ein Teil der Sen- 50 
soren Teil eines fahrdynamischen Lenksystems des Kraftfahrzeugs sind. 

3. Verfahren nach Anspruch I oder 2, dadurch gekennzeichnet, dass das in Schritt B erfasste Wegesignal von je ei- 
nem an jedem Fahrzeugrad beflndlichen Radgeschwindigkeitssensor erfasst wird. 

4. Verfahren nach einem der Anspruche 1 bis 3, dadurch gekennzeichnet, dass das in Schritt B erfasste Gierwinkel- 
signal von einem geeigneten Sensor gemessen wird. 55 

5. Verfahren nach einem der Anspruche 1 bis 3, dadurch gekennzeichnet, dass das in Schritt H erfasste Gierwinkel- 
signal aus einem oder mehreren in den Schritten B und C anderweitig gemessenen Signalen, insbesondere aus ei- 
nem Drehratensignal oder aus dem Wegesignal, rekonstruiert wird. 

6. Verfahren nach einem der vorangehenden Anspruche, dadurch gekennzeichnet, dass die Umgebungsbedingun- 
gen in Schritt C mittels eines Ultraschall sensors erfasst werden. 60 

7. Verfahren nach einem der vorangehenden Anspruche, dadurch gekennzeichnet, dass die in Schritt C erfassten 
Umgebungsbedingungen die Form und/oder AusmaBe einer Parklucke angeben. 

8. Verfahren nach einem der vorangehenden Anspruche, dadurch gekennzeichnet, dass die oder jede in Schritt D 
vorgegebene Soll-Trajektorie aus einem oder mehreren Klothoidbogen und/oder einem oder mehreren Kreisbogen 
zusammengesetzt werden. 65 

9. Verfahren nach einem der vorangehenden Anspruche, dadurch gekennzeichnet, dass die im Schritt E bcrechnctc 
StellgroBe einer Filterung unterworfen wird, urn zu vermeiden, dass die Lenkbeschleunigung und der Lenkruck zu 
hoch werden. 
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10. Vcrfahren nach eineni der vorangehenden Anspruchc, dadurch gekennzeichnet, dass Lenkeingriffe des Fahrcrs 
lolcriert werden, abcr keinen Einfluss aufdcn Einparkvorgang nehmen. 

11. Vcrfahren nach eineni der vorangehenden Anspriiche, dadurch gekennzeichnet, dass die Einparkgeschwindig- 
keit durch Gas- und Bremspcdaleingrifife des Fahrers beinflusst und die Lenkwinkel ausschlieBlich durch die Siell- 

5 bewegungen des Lenkslellmotors bewirkt werden. 

12. Vorrichlung zur Durchfiihrung des Verfahrens nach eineni der vorangehenden Anspriiche. dadurch gekenn- 
zeichnet, dass die Vorrichtung eine Regel-ZStcuereinheit, die von den Sensoren in Abhangigkcit von der Fahrzeug- 
position, dem Fahrzusland und den veranderlichen Umgebungsbedingungen erzeuglen Signalc sowie die Fahrzeug- 
daten empfangt, Millel zur Berechnung einer Ist-Trajektorie aus den Sensorsignalen und den Fahrzeugdaten, Mittel 

it) zum Vcrgleich der jeweils berechnetcn Ist-Trajektorie mil einer vorbestimmten Soll-Trajeklorie und Mittel zur Be- 

rechnung einer StellgroBc fur cinen Lcnkstellmolor aus dem Vergleichsergebnis aufweist. 

13. Vorrichtung nach Anspruch 12, dadurch gekennzeichnet, dass die RegeWSteuereinheit die von den jeweiligen 
Sensoren erzeuglen Signale sowie die Fahrzeugdaten von einer anderen Steuer-/Regeleinheil in dem Fahrzeug emp- 

15 14. Vorrichtung nach Anspruch 13, dadurch gekennzeichnet, dass die andere SteuerVRegeleinheit als ein fahrdyna- 

tnisches Lenksystem des Fahrzeugs ausgebildet ist. 

15. Vorrichtung nach einern der Anspruch 12 bis 14, dadurch gekennzeichnet, dass Filtermittel in funktioneller Vcr- 
bindung mil der Regel-/Steuercinheii vorgesehen sind, um die von der Regel-/Steuereinhcit berechnete SlellgroBe 
so zu filtern, dass die Lenkbeschleunigung und der Lenkruck nicht zu hoch werden. 
20 
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